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摘 要 : 二 维 耦 合 光学 摆 镜 是 扫描 式 星 载 红 外 光学 系统 的 关键 运动 部 件 ， 其 运动 特性 对 伺服 系统 提 
出 了 高 精度 位 置 控 制 与 运动 解 耦 的 特殊 要 求 。 在 建 模 与 仿真 分 析 的 基础 上 ， 提 出 了 一 种 新 的 耦合 含 
移 补偿 与 分 割 步 进 的 解 耦 策略 ， 采 用 位 置 环 与 速度 环 双 闭 环 的 PID 控制 算法 ， 使 用 有 限 转角 力 和 矩 电 
机 和 高 精度 旋转 变压器 作为 执行 与 测量 元 件 ,以 DSP 为 核心 构建 了 二 维 厅 合 光学 摆 镜 伺服 控制 系统 。 
实验 结果 表明 :该 方法 设计 的 控制 系统 二 维 运动 解 看 正确 , 控制 精度 高 ,响应 时 间 短 ,动态 特性 好 且 
超 调 小 ,可 广泛 应 用 于 高 精度 摆动 扫描 控制 系统 的 研究 领域 ,具有 很 好 的 工程 应 用 前 景 。 
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Abstract: Two-dimensional coupled optics swing mirror is a core module in an infrared optical scanning 
system of space, which demands special requirements of high precision and decoupling movement in a 
servo control system. A novel decoupling strategy called coupled offset compensation and segmentation 
stepping method was proposed based on accurate system modeling, abundant simulating and analysis 
results. The proposed servo control system of optics swing mirror was mainly constructed with a DSP 
chip, high precision brushless resolvers and limited angle brushless torque motors, which adopted position 
feedback and velocity feedback by PID algorithm. The experimental results indicate that the novel 
decoupling strategies are correct and that the servo control system makes the swing mirror achieve high 
precision movement which has a good dynamic characteristics, short response time and small overshoot. 
The method applied to the servo control system can be widely used in the field of high-precision swing 
scanning control system and possesses a great application prospect. 
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0 5 引 塞 


二 维 耦 合 光学 摆 镜 (以 下 简称 摆 镜 ) 是 扫描 式 星 
载 红外 光学 系统 的 关键 运动 部 件 ， 其 运动 的 高 精度 
位 置 控制 及 运动 解 耦 十 分 关键 ， 直 接 影响 着 系统 的 
性 能 。 

目前 ， 国 内 外 对 有 限 转角 力矩 电机 伺服 控制 系 
统 的 研究 主要 应 用 在 导弹 陀螺 .航空 合 服 阀 .导弹 舵 
机 、 雷 达 天 线 .电子 调 速 机 构 上 , 且 比 较 成 熟 ")。 而 
摆动 扫描 控制 系统 作为 运动 控制 系统 的 一 种 形式 ， 
主要 应 用 在 激光 测 距 仪 红外 目标 模拟 器 .摆动 式 红 
外 地 球 敏感 器 等 航天 领域 ,国内 外 关于 摆动 扫描 控 
制 系统 高 精度 快速 响应 方面 ,尤其 是 具有 运动 耦合 
关系 的 二 维 摆动 扫描 控制 系统 的 研究 相对 薄弱 , 因 
此 ， 文 中 对 具有 二 维 耦 合 机 构 的 光学 摆 镜 伺服 控制 
系统 进行 了 深入 研究 。 


1 摆 镜 工作 原理 


二 维 耦 合 摆 镜 结构 如 图 1 所 示 。 其 中 轴 1、 轴 2、 
轴 3 上 的 传动 轮 直径 相等 , 轴 1 称 为 方位 轴 , 轴 3 称 
为 俯仰 轴 。 设 轴 1、 轴 2、 轴 3 的 转角 分 别 为 01 62、 
63 , 则 可 推出 : 


(1) 


员 转角 =0] 
M2 转角 =02=01+03 


哆 


1 光学 摆 镜 示意 


哆 


Fig.1 Schematic diagram of optics Swing mirror 


摆 镜 工作 原理 如 图 2 所 示 ， 通 过 控制 方位 轴 和 与 
俯仰 轴 电 机 的 转动 ， 可 使 反射 镜 进 行 方位 和 俯仰 运 
动 ,最 终 使 像 点 在 像 方 坐标 系 (x,y) 上 做 指定 轨迹 的 
二 维 运 动 。 


摆 镜 对 伺服 控制 系统 的 要 求 是 ;在 +2.5° 的 范围 


内 ,以 15°%/s 的 速度 实现 误差 不 超过 +0.05° 的 精确 运 
动 , 且 像 点 二 维 运动 轨迹 偏差 不 超过 +0.05°。 
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图 2 摆 镜 光学 成 像 示 意图 


Fig.2 Image-forming diagram of mirror 


2 摆 镜 数字 控制 器 


二 维 耦 合 光学 摆 镜 系统 是 一 个 双 输 入 双 输 出 的 
耦合 系统 ,俯仰 轴 和 方位 轴 之 间 不 仅 存 在 位 置 耦合 ， 
而 且 还 存在 由 反射 镜 及 其 传动 机 构 的 转动 惯量 引起 
的 动态 力矩 耦合 。 故 首先 应 消除 俯仰 轴 和 方位 轴 之 间 
的 位 置 和 力矩 耦合 ,然后 再 将 系统 分 解 为 两 个 相互 独 
立 的 角 位 移 伺 服 系统 进行 控制 器 的 设计 与 实现 。 

2.1 位 置 解 看 策略 

摆 镜 像 方 坐 标 系 为 平面 直角 坐标 系 ， 如 图 3 所 
示 。 其 中 ,定义 原点 位 于 出 瞳 处 光学 成 像 圆 视 场 中 
心 ,f 为 水 平 坐标 轴 ,y 为 垂直 坐标 轴 ,(x*,y) 表 示 像 点 
在 圆 视 场 像 面 上 的 坐标 位 置 。 


ty axis/(°) 


2 


A(x1,y) 


0 » XAaxis/(°) 


图 3 摆 镜 运动 轨迹 示意 图 


Fig.3 Trajectory of the swing mirror 


反射 镜 从 光学 雪 位 分 别 治 方位 轴 与 俯仰 轴 分 别 
逆 时 针 方 向 转动 uv, 由 公式 (1) 可 以 推出 : 
U= Pp(S—S0) 
机 人 
(2) 


y= CU 一 如 _ p(s—s0) 
| Dn 94 
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式 中 :为 M] 和 M2 数字 绝对 式 角 位 置 传感器 的 分 
辩 率 ,p 为 其 满 量程 角度 。 设 当 s=s 且 {= 时 , 光 点 位 
于 (x,y) 的 原点 , 则 定义 绝对 转角 s=so 且 f= 为 系统 的 
光学 需 位 。 又 根据 图 2 中 两 组 光学 透镜 的 特性 可 知 : 


(3) 


式 中 ;a 与 B 为 光学 放大 系数 。 则 有 : 
2"0x 
9p 
大 2"(Qax+By) 二 
9 


| 


(4) 


上 式 为 摆 镜 运动 位 置 解 耦 的 数学 模型 . 由 此 模型 
可 知 , 摆 镜 轴 1 处 于 不 同 的 位 置 时 ,对 轴 2 产生 不 同 
的 位 置 偏 移 ,可 在 轴 2 输入 通道 加 上 轴 1 对 其 耦合 的 
位 置 偏 移 作为 轴 2 最 终 位 置 给 定 信 号 , 即 摆 镜 的 耦合 
关系 可 采用 耦合 偏 移 补偿 的 策略 进行 位 置 解 耦 。 

如 图 3 所 示 , 当 像 点 从 A(xi,yi) 运 动 至 B(x,,y,) 
时 ,根据 公式 (4) 可 分 别 计 算出 点 4 和 B 对 应 的 电机 
M1 与 M2 的 绝对 转角 (s1,4) 与 (5,,t), 即 实现 了 摆 镜 
的 位 置 解 耦 。 

2.2 力矩 解 耦 策略 

将 像 点 A.B 经 过 位 置 解 看 后 的 电机 参数 发 送 
至 控制 器 , 像 点 会 从 A 点 运动 至 B 点 。 然 而 ,由 于 驱 
动 轴 1 和 轴 2 的 电机 M1 与 M2 的 实际 运动 方向 . 速 
度 大 小 的 差异 , 轴 1 和 轴 2 通过 钢 带 相连 ,存在 阻力 
形式 的 耦合 力矩 ， 将 导致 像 点 无 法 从 A 以 指定 二 维 
轨迹 L 运动 至 有 ， 即 像 点 的 实际 运动 轨迹 是 一 条 任 
意 轨迹 的 二 维 曲线 L， 

在 像 方 坐标 系 下 ,通常 可 以 通过 设 定 治 x 轴 和 
y 轴 运动 的 速度 大 小 的 比例 关系 来 控制 像 点 的 运动 
方向 轨迹 。 然 而 ,由 于 摆 镜 钢 带 轴承 摩擦 之 类 的 非 
线性 ,电机 输出 力矩 与 响应 延迟 的 差异 性 ,使 得 像 点 
无 法 做 指定 轨迹 的 二 维 运动 。 

为 此 ， 文 中 提出 了 一 个 新 的 分 割 步 进 的 解 耦 策 
略 。 该 策略 将 指定 运动 轨迹 分 割 成 若干 固定 间隔 ,在 
每 个 间隔 内 , 像 点 先 治 x 轴 方 向 运动 一 步 ,此 时 电机 
MI1 与 M2 运动 方向 与 大 小 相同 ,不 存在 阻力 形式 的 
耦合 力矩 ;然后 再 治 > 轴 方 向 运动 一 步 ， 此 时 电机 
M1 保持 不 动 ,而 M2 电机 运动 一 步 。 摆 镜 等 间隔 逐 
级 步 进 ,最 终 到 达 指 定位 置 , 如 图 3 中 所 示 轨 迹 亡 。 
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为 了 达到 15°/s 的 速度 的 要 求 , 需 将 电机 速度 的 指标 
至 少 调整 为 30"/s。 当 分 割 间隔 足够 小 时 ,电机 间 的 
耦合 力矩 可 忽略 不 计 , 同 时 轨迹 六 可 近似 拟 合成 一 
条 直线 上 ,从 而 实现 了 摆 镜 的 力矩 解 耦 , 完 成 了 指定 
轨迹 的 二 维 运动 。 
2.3 控制 器 设计 和 与 仿真 

二 维 耦 合 摆 镜 解 耦 后 的 独立 伺服 系统 采用 速度 环 
与 位 置 环 双 闭 环 的 控制 方法 ， 控 制 系统 结构 如 图 4 所 
示 , 其 中 Gi(s) 和 G(s) 分别 为 位 置 控 制 环 与 速度 控制 环 
校正 网 络 的 传递 丁 数 ,Gs(s) 为 被 控 对 象 , 即 有 限 转 角力 
和 矩 电 机 及 其 负载 摆 镜 反射 镜 的 等 效 传递 丁 数 ,Ki 为 
PWM 功率 放大 器 的 放大 系数 ,有 为 速度 反馈 系数 。 


Position control 


4 控制 系统 结构 图 


Fig.4 Structure diagram of control System 


哆 


有 限 转角 力矩 电机 及 其 负载 的 数学 模型 为 . 


1/K. 
(Twst+1)(T.s+1) (3) 


式 中 :K. 为 电机 电动 势 系 数 ;7T, 为 机 电 时 间 常 数 ;TT 
为 电气 时 间 常 数 。 速 度 控制 环 由 速度 环 校 正 画 数 
Gs(s) .PWM 功率 放大 器 力矩 电机 负载 及 旋转 变 
压 器 组 成 。 速度 环 必须 满足 系统 所 要 求 的 速度 范围 ， 
同时 满足 位 置 回 路 所 要 求 的 动态 特性 要 求 。 校 正 函 
数 Gx(s) 由 串联 滞后 校正 环节 与 PI 控制 器 级 联 而 成 ， 
可 实现 速度 的 快速 控制 。 加 入 串联 滞后 校正 环节 的 作 
用 是 ;降低 系统 的 截止 频率 ,提高 系统 的 稳定 性 能 ， 
并 对 高 频 噪声 有 抑制 作用 。 G(s) 传递 醒 数 的 形式 为 : 


Gs(5)= 


om er es (0) 
则 速度 控制 环 的 闭环 传递 画 数 为 : 
G(s)= KiGa(s)Ga(s) i 


1+KiKsGa(s)Ga(s) 

在 设计 系统 位 置 控制 环 路 时 ， 可 将 速度 环 作为 

位 置 控制 回路 中 的 一 个 子 环节 考虑 。 为 有 效 地 抑制 

系统 的 超 调 ,同时 实现 位 置 的 精确 控制 ,位置 环 校正 
函数 Gi(s) 采 用 PD 控制 器 ,其 传递 西数 的 形式 为 : 

Gi(s)=Ka(1+Ts) (8) 
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从 而 ,位 置 控制 环 的 开 环 传递 画 数 为 : 


G(s)= 人 (9) 
其 闭环 传递 画 数 为 : 
__ Gx 
pv 1+G (10) 


将 有 限 转角 力矩 电机 及 负载 的 相关 参数 代入 公 
式 (10) ,经 matlab 计算 及 仿真 ,可 得 K,=20,K;=0.08， 
b=0.1 ,T=200, Ks=0.45, Kj=0.13, 

系统 开 环 频率 特性 曲线 与 闭环 阶 跃 响应 曲线 分 
别 如 图 5.6 所 示 。 
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图 5 系统 开 环 Bode 图 


Fig.5 Bode diagram of open loop 
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图 6 系统 闭环 阶 跃 响 应 曲线 


Fig.6 Step response curve of close loop 


由 图 可 知 ,系统 开 环 幅 值 裕 度 47.5 dB , 相 角 容 
度 86.5"。 系 统 闭 环 超 调 量 o 小 于 0.19% ,调节 时 间 
t=0.037s ,完全 满足 系统 对 位 置 回路 超 调 量 小 .过 渡 
平稳 的 性 能 要 求 。 

同时 还 可 以 看 出 ,单独 采用 位 置 回 路 进行 控制 
的 方案 系统 超 调 量 大 且 频 率 特性 差 。 在 光学 摆 镜 中 
必须 保证 低速 平稳 性 和 位 置 跟踪 精度 的 重要 环节 ， 
因此 ， 设 计 完善 速度 环 是 保证 伺服 系统 控制 性 能 的 
关键 一 环 。 
2.4 数字 控制 器 实现 方法 

文中 的 控制 算法 通过 恒 稳 变换 方法 双 线 性 
变换 ,将 连续 系统 校正 醒 数 Gi(s) 与 G(s) 进 行 离散 
化 。 双 线性 变换 的 形式 为 : 


$= 2 u 1-z” 
T 1+z- 


式 中 :7 为 系统 采样 周期 , 取 7=0.04 ms。 对 G1(s) 与 
Gs(s) 分 别 进行 双 线 性 变换 后 得 到 其 离散 形式 ,然后 
进行 计算 机 软件 编程 实现 摆 镜 的 数字 控制 。 
2.5 控制 系统 硬件 实现 

文中 使 用 有 限 转角 力矩 电机 作为 执行 元 件 ,以 
高 精度 旋转 变压器 作为 绝对 式 角 位 置 /速度 传感器 ， 
以 DSP 为 核心 构建 了 如 图 7 所 示 的 摆 镜 伺服 控制 
系统 ,上 位 机 采用 基于 RTX 实时 扩展 模块 的 Windows 
操作 系统 ， 通 过 PCI9054 卡 与 摆 镜 数字 控制 器 进行 
通信 。PCI9054 卡 采 取 3 路 LVDS 信号 进行 数据 传 
输 ,速率 可 达 120 Mbps ,完全 满足 系统 通信 高 速 实 时 
的 苛刻 要 求 。 控 制 器 不 断 采 集 旋 转变 压 器 的 位 置 与 
速度 信号 ,与 给 定位 置 比较 ,经 计算 输出 PWM 信号 
至 L298H 电机 了 驱动 模块 ， 逐 渐 修正 摆 镜 的 位 置 偏 
差 ,从 而 控制 摆 镜 进行 精确 的 二 维 运动 。 
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Fig.7 Servo control System of Swing mirror 
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3 实验 与 分 析 


动态 特性 实验 结果 如 图 8 所 示 。 电 机 运动 范围 
为 5.5"， 在 该 范围 内 系统 的 稳 态 误差 e.=0.005°, 运 
动 速度 为 38.46°/s ,响应 时 间 约 为 130 ms ,基本 无 超 
调 ， 达 到 了 光学 摆 镜 对 力矩 电机 高 精度 位 置 控制 与 
快速 响应 的 技术 要 求 。 
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Fig.8 Torque motors position response curve 
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像 点 运动 轨迹 实验 结果 如 图 9 所 示 。 像 点 从 
(0,0) 以 30°/s 的 速度 治 了 轴 运 动 至 (0,2.5), 左 侧 是 
旋转 变压器 返回 数据 生成 的 轨迹 曲线 , 右 侧 为 通过 黑 
体 点 光源 模拟 入 射 光 ,使 用 红外 热 像 仪 拍摄 的 像 点 轨 
人 迹 照 片 。 从 图 中 可 以 看 出 , 摆 镜 二 维 运 动 解 耦 正确 , 像 
点 实际 运动 轨迹 与 给 定 轨迹 基本 一 致 ,二 维 运动 轨迹 
偏差 为 +0.017°, 达 到 了 总 体 设计 的 技术 要 求 。 
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Fig.9 Trajectory of image-forming spot 
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4 结 论 
实验 结果 表明 ,该 方法 设计 的 伺服 控制 系统 ,二 
维 耦 合 摆 镜 解 看 控制 正确 ， 像 点 实现 了 指定 轨迹 的 


高 精度 二 维 运 动 (轨迹 偏差 e=+0.017?) ;位 置 随 动 控 
ee ;电机 响应 时 间 
短 ,动态 特性 好 (5.5° 响 应 时 间 130 ms); 取 得 了 很 好 


的 控制 效果 。 该 方法 可 广泛 应 用 于 摆动 扫描 控制 系 
统 高 精度 位 置 控制 的 研究 领域 ， 具 有 很 好 的 工程 应 
用 前 景 。 
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